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1,0 SUMMARY 

This report describes the modi Creations and additions made to the Flexible 
Spacecraft Dynamics (FSD) Program under contract NAS5-28128. The principal 
addition to the program was the capability to simulate a single axis gimbie plat- 
form nadir pointing despin control system. The formulation for the single axis 
gimbie equations of motion is a modification of the formulation given in Reference 
1, The details of the modifications made to the FSD Program are presented in Sec- 
tion 2. Modifications to existing subroutines are briefly described and a de- 
tailed description of new subroutines is given. In addition, the program variables 
in new labelled COMMON blocks are described in detail. Section 3 gives a descrip- 
tion of new input symbols for the FSD Program. 
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2.0 PROGRAM ADDITIONS AND MODIFICATIONS 


2.1 Summary of Modif icatio n s by Tas k 

Task 1. Control System Cor Imager Experiment 

A single axis platform on the spacecraft hub with a proportional, integral, 
and derivative (PID) feedback digital control system has been added to the 
program. Closed loop nadir pointing from a spinning spacecraft is provided. 
A first order sensor lag transfer function of the form: 


K 

S + oj 

where ca is the bandwidth and K is the sensor gain has been implemented for 
the nadir error signal. The integrator in the PID has a limiter on it and 
a zero order hold follows the output of the PID operating at the control rate. 
The despin motor has coulomb friction and different plus or minus torque 
limiting values. An inputed computational delay is included in the control 
system as well as a signal noise generator which can be added to the error 
signal. Provisions have been made for autonomous scan capability. The plat- 
form and control system are able to function concurrently with other platforms 
and control systems in the program. This capability is operable for INOPT 
1 and 2. 

Task 2. Internal Torques Generated by Moving Parts 

Calculation, printing, and plotting or internal reaction torques generated by 
moving (rotating) parts on the spacecraft; for example: motor torques in con- 
trol systems, momentum wheel torque, autonomous scanning, rastering torques, 
etc. has been added. This capability is operable for INOPT 1 and 2. 


Task 3. Autonomous Scan Capability Cor 2 Axis Scan Platform 


Currently, the FSD program has a 2 axis scan platform with close loop con- 
trol about both axes. Autonomous scanning has been added to the azimuth and 
elevation axes of the scan platform. This scanning capability is similar to 
the secondary body rastering option currently in the program. 

Task A. Spacecraft Field Components and External Disturbance Torques Without 
Attitude Dynamics 

For earth pointing systems (INOPT 2) an option has been added to constrain 
attitude angles to a fixed attitude (nominally roll, pitch and yaw are set to 
zero or fixed angles) and fly the spacecraft around the orbit. The magnetic 
field components in spacecraft coordinates and ascension and declination of the 
sun vector are determind. Also, torques due to aerodrag, solar pressure, gra- 
vity gradient, and magnetics are calculated and plotted. 

Task 5. Additional Fluid Dampers 

Two additional fluid nutation dampers have been added to the FSD program. These 
dampers are similar to the one that is currently in the program. The dampers 
can be arbitrarily oriented. The new damper option can be run in a stacked 
case where initially damping is zero and subsequently it is invoked. The 
additional dampers will permit wire motion dampers to be simulated concur- 
rently with a nutation dampers as well as other applications. The fluid dam- 
per option is operable for INOPT 1 and 2. 

2.2 Description of Subroutine Modifications 
The modifications made to existing subroutines are briefly described below. 

AIRDRG A calculation for aerodynamic torques on the spacecraft hub has been 
added. 

AWREAD Provision .for printing the motor torque has been added. 

BLK8 Titles have been added for labelling new plotted variables . 

Calls to new subroutines have been inserted. 


DEREQ 


ECHOGP 


Calls inserted for new echo print, 

FNDALP Calls to new subroutines have been inserted, 

GIMBL1 Modifications for gimble rastering have been inserted, 

GIMBL2 Modifications for gimble rastering have been inserted. 

GMBLRD Modifications for gimble rastering have been inserted. 

GMINIT Modifications for gimble rastering have been inserted. 

GPP LOT Calls inserted for new plotted output . 

GPSOUT Calls inserted for new printed output . 

MAIN Calls to new subroutines have been inserted. 

NUMPGE Calls inserted for new state variables , 

READGP Calls inserted for new input . 


2.3 Description of New Subroutines 
The new subroutines are described below. 


Subroutine Name: ADMDUM 


Language: FORTRAN IV 


Calling 

Sequence 

Purpose : 


CALL ADMDUM (N, DEL, DEP, DER, UP, DN, FAC, FRQ, TtSTOP, 

L, T, DELMIN) 

This multiple entry subroutine controls the program in the 
no integration, constant attitude simulations. 


Labelled 
Commons Used 


Subroutines 

Called 


CENVRN, 

ENERGY, 

VECTRS, 

CONSTS , 
LIBDPR, 
XIN2 

CNBODY , 
ORBNEW, 

CSTVAL , 
OUTTHR , 

IMAINl , 
RMGNTC , 

IP00L1, INOMOT, 
RP00L6, SUNVTR, 

ADMIMP, 

MATMPY, 

SET, XFIND 




Entries : Calling Sequence : CALL ADMWRP (BUFF, INDEX) 

Purpose : This entry loads data for plotting 

into the plot buffer. 

Calling Sequence : CALL ADMPRN 

Purpose : This entry provides for printed 
output using the subroutine SET. 
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Glossary o f Variables : 


Symbol 


N 

1*4 

DEL 

R*8 

DEP (150) 

R*8 

DER (150) 

R*8 

UP (150) 

R*8 

DN (150) 

R*8 

FAC 

R*8 

FRQ 

R*8 

TSTOP 

R*8 

L 

1*4 

T 

R*8 

DELMIN 

R*8 

BUFF (450) 

R*4 

INDEX 

1*4 


De£ipltion 

Humber of equations in state vector. 
Initial integration time step. 

State vector. 

State vector derivative. 

Integration error bound upper limit. 
Integration error bound lower limit. 
Time step change factor. 

Output record frequency. 

Integration stop time. 

Integration control integer. 
Integration time. 

Minimum allowable time step. 

Plot buffer. 

Plot buffer address . 


Subroutine Name 

Language : 

Calling , 
Sequence 

Purpose : 

Labelled 
Commons Used : 

Subroutines , 
Called 

Entries : 


RASTGM 
FORTRAN IV 

CALL RASTGM (ANG, ANGD, ANGDD) 

RASTGM calculates prescribed angular motion for the 
two axis gimble . 

CONSTS, CRSTGM, CSTVAL, IRSTGM, RPOOL1 
None . 


None . 


Glossary of Variables 


Symbol Type Definition 


ANG (3) 

R*8 


Prescribed angular position 
for two axis gimble platform. 

ANGD (3) 

R*8 


Prescribed angular velocity 
for two axis gimble platform. 

ANGDD (3) 

R*8 


Prescribed angular acceleration 
for two axis gimble platform. 

Subroutine Name : 

RASTSA 



Language : 

FORTRAN IV 



Calling , 
Sequence* 

CALL RASTSA (ANG 

, ANGD, 

ANGDD) 

Purpose : 

RASTSA calculate 
the single axis 

s prescribed angular motion for 
gimble . 

Labelled 
Commons Used 

CONSTS, CSAGRS, 

CSTVAL, 

ISAGRS, RPOOLl 

Subroutines 
Called : 

None . 



Entries ? 

None . 




Glossary of Variables 


Symbo 1 

JZ£i 

De finition 

ANG (3) 

R*8 

Prescribed angular position for 
single axis gimble platform. 

ANGD (3) 

R*8 

Prescribed angular velocity for 
single axis gimble platform. 

ANGDD (3) 

R*8 

Prescribed angular acceleration 
for single axis gimble platform 
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Subroutine Name : 
Language : 

Calling Sequence: 
Purpose : 

Labelled 
Commons Used 

Subroutines 
Called : 


SAGIM1 
FORTRAN IV 

CALL SAGIM1 (SY1, SY2, SY3, CIY) 

To add gimble mas3 properties into system mass properties 
and set up gimble equations o£ motion* 

CONSTS, CSAGIM, SAGMWK, SAGOUT, SAPRPL, SARSOT, ISAG1M, 
ISAGRS, RP00L1, VARBLS 

MPYMAT, MATV, ADDV, RASTSA 


Glossary of Variables 


Symbo 1 

Type 

Definition 

SYl 

R*8 

S v i d " 

SY2 

R*8 

Y 2 d " 

SY3 

R*8 

$V" 

CIY (3,3) 

R*8 

CIY(I , J) 1 


Subroutine Name : SAGIM2 

Language : FORTRAN IV 

Calling Sequence : CALL SAGIM2 (ITEST, ZML, ETA, NALP) 

To complete calculation o£ gimble equations o£ motion 
and determine gimble accelerations . 

CSAGIM, DEBUG2, SAGMWK, SAGOUT, HSAGIM, ISAGIM, ISAGRS, 
RP00L1, RPOOL3, SARSOT, TRQOUT, VARBLS 

MATV, ADDV, MPYMAT, SAGINF, SAGCNT 


Purpose : 

Labelled 
Commons Used 

Subroutines 

Called 
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Glossary of Variables 


Symbol 

Im. 

De finition 

[TEST 

1*4 

Internal control word. 

ZML (7*7) 

R*8 

System equations of motion 
mass and inertia coupling 
matrix . 

ETA (7) 

R*8 

System acceleration vector 

NALP 

1*4 

No. of system equations of 
motion . 


Subroutine Name : 

SAGINF 


Language : 

FORTRAN IV 


Galling 

Sequence 

CALL SAGINF (AZIF) 


Purpose ; 

To calculate internal 
azimuth equations of 

spring and damping forces for 
motion . 

Labelled 
Commons Used 

SAINTF, SAGOUT 


Subroutines . 
Called 

None 



Glossary of Variables 

Symbol Type Definition 


AZIF 


R*8 


Internal spring and damping 
moment for azimuth equation 
of motion . 


Subroutine Name 

Language i 

Calling , 
Sequence 

Purpose : 

Labelled 
Commons Used 

Subroutines 

Called 

Entries : 


SAGMRD 
FORTRAN IV 

CALL SAGMRD 

This subroutine performs input and output tasks for the 
single axis gimble simulation. 

CSAGIM, CSAGRS , SAGICS, SAINTF , SAPRPL, ISAGIM, ISACRS 

SETUP, SAPLCS, HVAL, IVAL, FVAL, SET 

ECHOSA, SAGPLT, SAPRNT 
Calling Sequence : CALL ECHOSA 

Purpose : This entry performs echo printout 

of the input for the single axis gimble. 

Calling Sequence : CALL SAGPLT (BUFF, INDEX) 

Purpose : This entry provides for writing of 

output data to be used in printer plots. 

Calling Sequence : CALL SAPRNT 

Purpose : This entry provides for printed output 

data. 


Glossary of Variables 


Symbol 

1m. 

Definition 

BUFF (450) 

R*4 

Output vector of plotting 
variables , 

INDEX 

1*4 

Location in BUFF of last 
variable used. 


Subroutine Name : SAINIT 


Language : 

Calling , 
Sequence 

Purpose : 


FORTRAN IV 
CALL SAINIT 

This subroutine docs initial calculations for the 
single axis gimble simulation. 


Labelled , 
Commons Used 


ADSTAT, CONSTS, 
CSACIM, CSACRS 


SAGICS, SAGOUT, 


ISAGIM, ISAGRS, 


Subroutines 

Called 


DTR312 


Glossary of Variables s 

Significant variables are. defined in labelled common. 


Subroutine Name 

Language : 

Calling , 
Sequence 

Purpose : 


Labelled 
Commons Used 


Subroutines . 
Called : 

Entries : 


SAPLCS 
FORTRAN IV 

CALL SAPLCS 

This multiple entry subroutine contains all the coding 
relative to the control system for the single axis 
gimble platform. 

ADSTAT, CONSTS, CSAPCS, CSTVAL, DATOUT, DEBUG2, DRPROT , 

SAGOUT, HSAGIM, ISAGIM, IMAINl. INEWR, IPOOLl, MOMENT, 

OUTTHR, RMAINl, RMGNTC, RPOOL1, RPOOL5, VARBLS , XIN4 

SETUP, HVAL, FVAL, MATV, SET 

Calling Sequence : CALL NUMSAP (NUMEQS) 

Purpose : This entry adds the three sensor transfer 

function equations to the equation counter. 

Calling Sequence : CALL ECHSAC 

Purpose : This entry provides for echo printout 

of the single axis gimble platform 
control system parameters. 
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Calling Sequence : 

CALL SACINT (FRQ) 

Purpose : 

This entry sets the initial values 
into the DEPEND array. 

Calling Sequence : 

CALL SACSNR 

Purpose : 

This entry provides for calculation 

of the 3ensor transfer function derivatives. 

Calling Sequence : 

CALL SACCNT (AZCNT) 

Purpose : 

This entry calculates the motor torques 
for the single axis gimble drive motor* 

Calling Sequence : 

CALL SAPIDC (IPRFLG) 

Purpose ; 

This entry calculates the output of the 
PID controller for the single axis gimble. 
axis 

Calling Sequence : 

CALL SAPWRP (BUFF, INDEX) 

Purpose ; 

This entry loads data for plotting into 
the plot buffer. 

Calling Sequence : 

CALL SAPPRN 

Purpose : 

This entry provides for printed output 
using the subroutine SET. 


Glossary oE Variables 



Symbol 

Type 

Definition 

NUMEQS 

1*4 

The number of equations in 
the state vector. 

FRQ 

R*8 

Frequency of integrator returns 
to MAIN by ADMIMP . 

AZCNT 

R*8 

Gimble drive motor torque . 

IPRFLG 

1*4 

Internal control for frequency 
of printed output records. 

BUFF (450) 

R*4 

Output vector for plotted output. 

INDEX 

1*4 

Location in BUFF of last entered 
data . 
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Subroutine Name : TRQORD 


Language : 

Calling , 
Sequence 

Purpose : 

Labelled 
Commons Used 

Subroutines, 
Cal le i 

Entries : 


FORTRAN IV 


CALL TRQORD 


To provide for output of internal reaction torques. 
ITRQOT, TRQOUT 


SETUP, SET 

Calling Sequence : CALL TRQPLT (BUFF, INDEX) 
Purpose : To load variables for plotting. 

Calling Sequence : CALL TRQPRN 

Purpose : To provide for printed output 

using the subroutine SET, 


Glossary of Variables 


Symbol 
BUFF (450) 


INDEX 


1X22. 


De finition 

Output vector for plotted 
output . 

Location in BUFF of last entered 
data. 


Subroutine Name : VDMPBB 

Language : FORTRAN IV 

Calling Sequence ; CALL VDMPRD 
Purpose ; To provide 


Labelled 
Commons Used 


To provide for the simulation and torques generated by 
additional viscous ring dampers. 

ADSTAT, CONSTS, DEBUG2, IMAIN1, OUTAVD, RP00L1, RAVSCS, 
XIN4 


Subroutines 

Called 


SETUP, FVAL, HVAL, IVAL, SET 






Entries ; 


Catling Sequence : 

CALL NUMVDE (NUMEQS) 

Purpose : 

To augment state vector size for 
viscous damper variables. 

Calling Sequence : 

CALL ECHOVD 

Purpose : 

To provide echo print of viscous 
damper parameters. 

Calling Sequence : 

CALL VDINIT 

Purpose ; 

To initialize state vector for viscous 
damper initial conditions. 

Calling Sequence : 

CALL VISCS2 (IT, ZML, OM, OMD, DEP, DER, CMP) 

Purpose J 

To calculate damper variable derivatives 
and damper reaction moments on the system. 

Calling Sequence ; 

CALL VDPRNT 

Purpose : 

To load print variables into print buffer 
for printing. 


Glossary o£ Variables 


Symbol 

Mi 

Definition 

NUMEQS 

1*4 

The number of equations in the 
state vector. 

IT 

1*4 

Internal control integer. 

ZML (7*7) 

R*8 

System mass and inertia coupling 
matrix. 

OM (3) 

R*8 

System angular velocity. 

OMD (3) 

R*8 

System angular acceleration. 

DEP (150) 

R*8 

State vector. 

DER (150) 

R*8 

State vector derivative. 

CMP (3,2) 

R*8 

Damper reaction torques. 


2 . 4 Description of New Labelled Common 
The new labelled COMMON blocks are described below. 

Common Block Name : COMMON /CRSTGM/DELA( 3) , TAUA(4,3), ANG0(3), 

ADD0<3), TC(3), TTAB(4, 3) 


Used in Subroutines: 

GMBLRD, GMINIT, 

RASTGM 


Variables: 

Fortran Name 

Im 

Units 

Description 

DELA (3) 

R*8 

Deg. 

Angular motion to be performed 
in a single cycle of rastering 
motion . 

TAUA(4,3) 

R*8 

Sec. 

Time increments for rastering 
cycle , 

ANGO (3) 

R*8 

Deg. 

Initial angle for start of 
rastering cycle. 

ADDO (3) 

R*8 

Deg . /Sec. 2 

Peak rastering acceleration. 

TC (3) 

R*8 

Sec. 

Total cycle time for each axis . 

TTAB (4,^) 

R*8 

Sec. 

Cycle times . 


Common Block Name ; COMMON/CSAGIM/AZIN (3,3), AZAX(3), AZCG(3), AZMS, AZYY(3,3) 

AZIAX(3,3), ZZAZ(3,3) 

Used in Subroutine : SAGM, SAINIT, SAGIM1, SAGIM2 


Variables : 


Fortran Name 

1X21 

Units 

Description 

AZIN(3, 3) 

R*8 

Slug-Ft 2 

Moment of inertia of gimble 
platform about its own center 
of mass . 

AZAX( 3) 

R*8 

Ft. 

Location of gimble axis in 
body frame . 

AZCG(3) 

R*8 

Ft. 

Location of platform center 
of mass in platform reference 
frame . 



Fortran Name 

1X21 

Units 

Description 

AZMS 

R*8 

Slugs 

Mass of platform. 

AZYY(3,3) 

R*8 

Slug-Ft 2 

^Z^Zjdm for platform 
about its center of mass. 

AZIAX(3,3) 

R*8 

Slug-Ft 2 

\Z.Zjdm for platform 
**afeout the azimuth frame 
origin. 

ZZAZ(3,3) 

R*8 

Slug-Ft 2 

\Z,Z r dm for gimble plat- 


forms about frame origin. 


Common Blck Name : 
Used in Subroutines 

COMMON/ CSAGRS/DELA<3), TAUA(4,3), 
TC(3), TTAB(4,3) 

: RASTSA, SAGMRD* SAINXT 

ANGO ( 3 ) , ADD0(3), 

Variables : 

Fortran Name 

Type 

Units 

Description 

DELA(3) 

R*8 

# Deg. 

Angular motion to be per- 
formed in a single cycle 
of rastering motion . 

TAUA(4, 3) 

R*8 

Sec. 

Time increments for 
rastering cycle . 

ANG0(3) 

R*8 

Deg. 

Initial angle for start 
of rastering cycle . 

AD DO (3) 

R*8 

Deg/Sec 2 

Peak rastering acceleration. 

TC(3) 

R*8 

Sec . 

Total cycle time for each 
axis . 

TTAB(4j 3) 

R*8 

Sec. 

Cycle times . 

Common Block Name : 
Used in Subroutine: 

COMMOM/ CSAPCS/PCSPRM(100) , IPLTCS(20) 
SAPLCS 

Variables: 

Fortran Name 

1X21 

Units 

Description 

PCSPRM(IOO) 

R*8 

Varies 

Parameters used in the 
single axis gimble platform 
control system. 

IPLTCS(20) 

1*4 

N.A. 

Integer control words for 


for single axis gimble plat- 
form control system. 
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Common Block Name : COMMON/INOMOT/NOINTG, NOIOUT(20) 
Used in Subroutines: ADMDUM, READGP 

Variables : 


Fortran Name 


l2£® 

Units 

Description 

NOINTG 


1*4 

N.A. 

Control integer for simu- 
lation without integration. 

NOI0UT(20) 


1*4 

N.A, 

Control integers for output 
of spacecraft external torques. 

Common Block 

Name : 

COMMON/ IRSTGM/ IRAST , 

IARST(3), 

IRSCY(3) 

Used in Subroutines 

: GIMBLl, GIMBL2 , GMBLRD, GMINIT 

, RASTGM 

Variables : 





Fortran Name 


IZ£i 

Units 

Description 

IRAST 


1*4 

N.A. 

Control word to invoke pre- 
scribed rastering motion 
for two axis gimble* 

IARST(3) 


1*4 

N.A. 

Control word to specify type 
of rastering cycle. 

IRSCY(3) 


1*4 

N.A. 

Number of cycles of rastering 
motion to be performed. 

Common Block 

Name : 

COMMON/ 1 S AGIM/ IGMBL , 

NAZIM, NAI 


Used in Subroutines 

: SAGMRD, SAINIT, SAGIMl, S AGIM 2 

, SAPLCS 

Variables: 





Fortran Name 


Type 

Units 

Description 

IGMBL 


1*4 

N.D. 

Control word for gimble 
simulation. 





IGMBL 0 No gimble simulation. 





IGMBL 1 Single axis gimble 
simulation. 

NAZIM 


1*4 

N.D. 

Location in the state vector 
of the gimble angle. 

NAI 


1*4 

N.D. 

Location in the state vector 
of the gimble angular velocity. 
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Common Block Name: COMMON/ ISAGRS/IRAST, IARST(3), IRSCY(3) 
Used in Subroutines: RASTSA, SAGXMl, SAGXM2, SAGMRD , SAINXT 


Variables: 




Fortran Name 

Type 

Units 

Description 

IRAST 

1*4 

N.A. 

Control word to invoke 
prescribed rastering motion 
for single axis gimble. 

IARSTC3) 

1*4 

N.A. 

Control word to specify 
type of rastering cycle. 

IRSCY(3) 

X*4 

N.A. 

Number of cycles of ras- 
tering motion to be per- 
formed , 


Common Block Name: COMMON/ITRQOT/IOUTPT(150) 

Used in Subroutines: TRQORD 

Variables : 

Fortran Name Type Units Description 

IOUTPT(150) 1*4 N.A. Vector of control integers 

for reaction torque output . 


Common Block Name: COMMON /OUTAVD/OMEGU 2) , VSUBL(2), MSUBM(3,2) 
Used in Subroutines: VDMPRD 

Variables: 


Fortran Name 


Units 

Description 

0MEGL(2) 

R*8 

Rad. /Sec. 

Angular velocity of 
damping fluid. 

VSUBL(2) 

R*8 

Ft. /Sec. 

Velocity of damping fluid 

MSUBM(3,2) 

R*8 

Ft. /Sec. 

Damping torque from fluid 
damper. 


Common Block Name: COMMON/RAVSCS/NSUBX<3,2), YARRAY( 3 , 2 ) , RADTBE (2) , 

VISCTY(2), RADRNG(2), DENSTY{2), JARRAY(3,2) 
SSUBY(2), OMLI(2) , ISUBD(2), VUP(2), VDN(2), NVD 

Used in Subroutines: VDMPRD 


Variables : 


Fortran Name 

M 

Units 

Description 

NSUBX{3 , 2) 

R*8 

N.D. 

Unit vectors in direction 
o£ damper axis. 

YARRAY (3,2) 

R*8 

Ft. -Lbs. 

Initial components of torque 
along damper axis. 

RADTBE (2) 

R*8 

In. 

Radius o£ damper tubes. 

VISCTY(2) 

R*8 

Centi 

Stokes 

Viscosity of liquid. 

RADRNG(2) 

R*8 

In. 

Radius of damper ring. 

DENSTY(2) 

R*8 

Lbs. /Ft 3 

Fluid density. 

JARRAY(3,2) 

R*8 

— 

Initial values for bessel 
functions . 

SSUBY(2) 

R*8 

- 

Damping torque. 

0MLX(2) 

R*8 

Deg/sec. 

Initial fluid angular 
ve locity . 

ISUBD(2) 

R*8 

Slug-Ft 2 

Fluid moment of inertia. 

VUP{2) 

R*8 

- 

Integration upper bound. 

VDN ( 2 ) 

R*8 

- 

Integration lower bound, 

NVD 

1*4 

N.A. 

Number of additional 
viscous ring dampers. 

Common Block Name: 
Used in Subroutines 

common/ sagics/azimo, 

GMUP (2 ) 

: SAGMRD, SAINIT 

ROLLO, ELEVO, 
, GMDN(2) 

AZIMI, AZIMID, 

Variables: 

Fortran Name 

Type 

Units 

Description 

AZIMO 

R*8 

Deg. 

Rotation about the three 
axis in a 3-1-2 rotation 
from the body frame to the 
gimble motion reference 
frame. 


Fortran Name 

Im. 

Units 

Description 

ROLLO 

R*8 

Deg, 

Rotation about the one axis 
in a 3-1-2 rotation Erom 
the body Erame to the girnble 
motion reEerence frame. 

ELEVO 

R*8 

Deg, 

Rotation about the two axis 
in a 3-1-2 rotation from 
the body frame to the gimble 
motion reference frame. 

AZIMI 

R*8 

Deg. 

Initial angular position o£ 
the gimble platform. 

AZIM1D 

R*8 

Deg/Sec 

Initial angular velocity 
o£ the gimble platform. 

GMUP (2) 

R*8 

RAD 

Rad/Sec 

Integration upper bounds for 
gimble rotation and 
rotation rate. 

GMDN ( 2 ) 

R*8 

RAD 

Rad/ Sec 

Integration lower bounds for 
gimble rotation and 


rotation rate- 


Common Block Name : COMMON/ SAGMWK/ BELT, GAMGM ( 6 ) , GMRHS, DI, DIGAM(6 ) 


Used in Subroutines: 

DZML(6,6), YAZB(3) 
SAGIM1, SAGIM2 


Variables 

Fortran Name 

Type 

Units 

Description 

DELT 

R*8 

Slug/Ft 2 

Diagonal coefficient for 
platform acceleration. 

GAMGM ( 6 ) 

R*8 

Varies 

Coupling matrix between 
platform acceleration and 
system translational and 
rotational accelerations . 

GMRHS 

R*8 

Ft-Lbs, 

Torques for platform equation 
of motion . 

DI 

R*8 

— 

Inverse of £$1 *£$1’ 

DIGAM (6) 

R*8 

— 

Wcon, _ 

DZML(6,6) 

R*8 

— 


YAZB(3) 

R*8 

Ft. 

Location of the axis 
measured in the platform 
reference frame . 


Common Block Name: COMMON/ SAGOUT/AZ, AZD, B(3,3), BO(3,3), C(3,3), BOBC(3,3), 

YAZ(3), ZAZM(3) 

Used in Subroutine: SAGINF, SAINIT, SAGIMI, SAGIM2, SAPLCS 


Variables 




Fortran Name 

Type 

Units 

Description 

AZ 

R*8 

Rad. 

Angular position of the 
gimble platform. 

AZD 

R*8 

Rad/Sec, 

Angular velocity of the 
gimble platform. 

B(3,3) 

R*8 

N.D. 

Transformation matrix 
from the azimuth plat- 
form reference frame 
to the gimble motion 
reference frame. 

BO(3,3) 

R*8 

N.D. 

Transformation matrix 
from the gimble motion 
reference frame to the 
body frame . 

808(3,3) 

R*8 

N.D. 

(bobJ - 0J}] 

C(3,3) 

R*8 

N.D. 

Transformation matrix 
from the elevation plat- 
form reference frame to 
to the azimuth platform 
reference frame. 

BOBC(3,3) 

R*8 

N.D. 

HN 

YAZ(3) 

R*8 

Ft. 

Position of the azimuth 
gimble CG from the body 
frame origin measured in 
the body frame . 

ZAZM(3) 

R*8 

Slug-Ft , 

First moment of the gimble 
mass about the azimuth 
gimble frame origin. 


Common Block Name: COMMON/ SAINTF/GMK1 , GMK2 , GMDMP, GMSTP 
Used in Subroutines : SAGINF, SAGMRD 


Variab les 




Fortran Name 

im. 

Units 

Description 

GMK1 

R*8 

Ft-Lbs/Rad 

Spring constant for gimble 
suspension. 

GMK2 

R*8 

Ft-Lbs/Rad 

Stop spring constant fop 
gimble suspension. 

GMDMP 

R*8 

Ft-Lb-Sec/Rad 

Viscous damping constant 
for gimble suspension. 

GMSTP 

R*8 

Rad 

Stop angle for gimble 
suspens ion* 


Common Block Name: COMMON/ SAPRPL/GMBAZ, GMBAZD 
Used in Subroutines : SAGIMlj SAGMRD 


Variables 


Fortran Name 

IZEi 

Units 

Description 

GMBAZ 

R*8 

Deg. 

Output angular position 
of gimble platform. 

GMBAZD 

R*8 

Deg/Sec, 

Output angular velocity 
of gimble platform. 

Common Block Name : 
Used in Subroutines: 

COMMON/ SARSOT/ AZDD 
SAGIM1, SAGIM2 

, SARHSTO), 

SARHSR(3) 

Variables 

Fortran Name 

Type 

Units 

Description 

AZDD 

R*8 

2 

Rad/Sec, 

Platform angular acceleration 
during rastering cycle. 

SARHST(3) 

R*8 

Lbs . 

Inertial forces on system 
translation due to platform 
rastering motion. 

SHRHSR(3) 

R*8 

Ft. -Lbs . 

Inertial torques on system 
rotation due to platform 
rastering motion. 


\ 


Common Block Name : 

COMMON /TRQOUT/OUTTRQ (150) 


Used in Subroutines 

5 TRQORD, 

WHREAD, AWREAD 


Variables 




Fortran Name 

Type 

Units 

Description 

OUTTRQ( 150) 

R*8 

Ft-Lbs . 

Vector or reaction torques 
for output. 

) DESCRIPTION OF NEW 

INPUT AND OUTPUT 


3.1 Single Axis Platform Simulation Input and Output 

Fortran Symbol 

Type 

Preset 

Value 

Description 

ISAGM 

1*4 

0 

Control word for single axis 
platform simulation. 




ISAGM 0 No platform simulated. 
ISAGM l Platform simulated. 

SAIN(3,3) 

R*8 

O.ODO 

Moments of inertia of the single 
axis platform about its own center 
of mass(slug-ft^) . 

SAAX(3) 

R*8 

O.ODO 

Position vector in the bady frame 
to the origin of the platform 
motion reference frame. This 
position is a point on the motion 
axis (ft.). 

SACG ( 3 ) 

R*8 

O.ODO 

Position vector to the platform 
center of mass in the platform 
motion reference frame (ft.). 

SAMS 

R*8 

O.ODO 

Mass of the platform (slugs'). 

SAK1 

R*8 

O.ODO 

Spring constant for single axis 
gimble suspension. Applies to 
angles less than the stop angle 
(ft-lb/rad). 

SAK2 

R*8 

O.ODO 

Spring constant for single axis 
p. T >tform suspension. Applies to 
angles greater than the stop angle 
(ft-lb/rad) . 

SAGDM 

R*8 

O.ODO 

Viscous damping cons tent for 
single axis platform suspension 
(ft-lb-sec/rad) , 



?? 



i 


Fortran Symbol 

Type 

Preset 

Value 

Description 

SASTP 

R*8 

0.0D0 

Stop angle for single axis 
platform suspension (rad). 

SAAZO 

R*8 

0.0D0 

Rotation about the three axis 
in a 3-1-2 angle set from the 
main body frame to the platform 
moticn reference frame (deg). 




NOTE: The gimble motion refer- 
ence frame is a main body fixed 
frame. 

SARLO 

R*8 

O.ODO 

Rotation about the one axio in 
a 3-1-2 angle set from the main 
body frame to the platform 
motion reference frame (deg). 

SAELO 

R*8 

0.0D0 

Rotation about the two axis in 
a 3-1-2 angle set from the main 
body frame to the platform 
motion reference frame (deg). 

SAAZI 

R*8 

O.ODO 

Initial azimuth angular position 
for the single axis platform 
(deg). 

SAA2ID 

R*8 

O.ODO 

Initial azimuth angular velocity 
for the single axis platform 
(deg/sec) . 

SAUP ( 2 ) 

R*8 

1.0D-3 

Integration upper bounds for 
platform angle and angular 
rate. 




SAUP ( 1 ) (rad). 
SAUP(2) (rad/sec). 

SADN(2) 

R*8 

1.0D-5 

Integration lower bounds for 


platform angle and angular 
rate . 


SADN(l) (rad). 
SADN(2) (rad/sec). 


Single Axla Platform Rastering Input 


Foreran Symbol 
ISAGRS 

ISARST(l) 

ISASCY 

SADELA 

SATAUA (4,3) 
SAAN20 


Type 

1*4 


1*4 


1*4 

R*8 

R*8 


R*8 


Preset | 

Vn lue Description * 

0 Control word to Invoke prescribed 

rastering motions for single 
axis platform. 

ISAGRS ■ 0 No rastering, 

ISAGRS ■ 1 Rastering prescribed. 

0 Control word to specify type of 

rastering cycle to be invoked 
on single axis platform, J 

ISARST(l) ■ 0 No motion, j 

ISARST(l) ■ 1 Motion of Type 1, 

ISARST(l) “ 2 Motion of Type 2. 

i 

NOTE: The types of motion cycles [ 

are shown in Reference 2. ! 

0 Number of cycles of rastering ! 

motion to be performed, j 

0.0D0 Angular motion to be performed ’ 

during a single cycle of rastering 
motion (deg.). j 

O.ODC Time increments to define ras- 
tering cycle. i 

SATAUA (1,1) - T l 
SATAUA (2,1) » T 2 
SATAUA (3,1) » T 3 

SATAUA (4,1) - T. ! 

** \ 

O.ODO Initial angle for the start of j 

the rastering cycle (deg.). j; 
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Plotting locations for single axis platform motion variables 


Fortran Symbol 
KPLOTS(341 ) 
KPLOTS(342) 


Descriptio n 

Angular position for the single axis plotform. 
Angular rate for the single axis platform. 


Single Axis Platform Printed Output 


Fortran Symbol 
GMBL AZ 
GMBL AZD 


Description 

Platform azimuth angle 
Platform azimuth angular velocity 


Units 

Deg. 

Deg/Sec. 


3,2 Single Axis Platform Nadir Pointing Control System Input and Output 

Preset 

Fortran Symbol Type Value Description 

1SAPCS (1-20) 1*4 0 Control words for gimble plat- 

form control system simulation. 


1SAPCS (1) Control word to invoke the 

single axis platform control 
system option, 

ISAPCS(l) 0 No control system, 
ISAPCS(l) 1 Control system, 

NOTE: If a control system is 
invoked the single axis plat- 
form simulation must also be 
invoked. 


ISAPCS (3) Control word for guassian noise 

transfer function for the three 
axes of the nadir sensor. 

ISAPCS (3) 0 No transfer function 

ISAPCS (3) 1 Transfer function. 


» 
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Single Axis Platform Nadir Pointing Control System (continued) 


Foreran Symbol 

Type 

Preset 

Value 

Description 

ISAPCS (4) 



Number of measurement samples 
to be averaged for smoothing 
of sensor output. 




ISAPCS(4) N average N samples 




N 1 

ISAPCS (5-20) 



Not used. 

SACSPM (100) 

R*8 

0.0D0 

Platform control system 
parameters . 

SACSPM (1-9) 



Not used. 

SARSPM (10) 



Sampling time for PID 
digital controller (sec). 

SACSPM (11) 



Quantatisational level for 
platform position (rad). 

SACSPM (12) 



PID integrator upper satur- 
ation limit (rad). 

SACSPM (13) 



PID integrator lower satur-' 
ation limit (rad). 

SACSPM (14) 



PID proportional gain 

SACSPM (15) 



PID integrator gain 

SACSPM (16) 



PID derivative gain 

SACSPM (17-29) 



Not used. 

SACSPM (30) 



Integration upper bound for 
sensor first order lag trans- 
fer function. 

SACSPM (31) 



Integration lower bound for 
sensor first order lag trans- 
fer function. 

SACSPM (32) 



Sensor one axis bandwidth. 

SACSPM (32) 



Sensor two axis bandwidth. 

SACSPM (34) 



Sensor three axis bandwidth. 

SACSPM (35) 



Sensor sampling rate (sec). 

SACSPM (36) 



Computational delay (sec). 

SACSPM (37-40) 



Not used. 

SACSPM (41) 



Single axis platform amplifier 


gain K a . 


Single Axis Platform Nadir Pointing Control System (continued) 


Fortran Symbol 

Description 

SACSPM (42) 

Platform motor torque constant 

k t . 

SACSPM (43) 

Platform back EMF constant Kg* 

SACSPM (44) 

Platform motor torque upper 
limit (ft-lbs). 

SACSPM (45) 

Platform motor torque lower 
limit L- (ft-lbs). 

SACSPM (46) 

Platform coulomb friction 
torque constant (ft-lbs). 

SACSPM (47) 

Platform minimum angular rate 
for coulomb friction torque 
(rad/sec). 

SACSPM (48) 

Platform voltage bias. 

SACSPM (49-79) 

Not used. 

SACSPM (80) 

Amplitude of sinusoidal noise 
added to one axis sensor 
measurement (gauss). 

SACSPM (81) 

Amplitude of sinusoidal, noise 
for two axis (gauss). 

SACSPM (82) 

Amplitude of sinusoidal noise 
for three axis (gauss). 

SACSPM (83) 

Phase of sinusoidal noise added 
to one axis sensor measurement 
(deg). 

SACSPM (84) 

Phase of sinusoidal noise for 
two axis (deg). 

SACSPM (85) 

Phase of sinusoidal noise for 
three axis (deg). 

SACSPM (86) 

Frequency of sinusoidal noise 
added to one axis magnetometer 
measurement (cps). 


Single Axis Platform Nadir Pointing Control 

System (continued) 

Fortran Symbol 

Description 

SACSPM (87) 

Frequency of sinusoidal noise 
for two axis (cps). 

SACSPM (88) 

Frequency of sinusoidal noise 
for three axis (cps). 

SACSPM (89) 

Not u9ed. 

SACSPM (90-95) 

Used internally. Not input. 

SACSPM (96-100) 

Not used. 


Plotting Locations for Platform Control System Variables 
Input Symbol Description 


KPLOTS 

(343) 

Output of first order lag transfer 
for sensor one axis. 

function 

KPLOTS 

(344) 

Output of first order lag transfer 
for sensor two axis. 

function 

KPLOTS 

(345) 

Output of first order lag transfer 
for sensor three axis. 

function 

KPLOTS 

(346) 

Position error output. 


KPLOTS 

(347) 

PID digital controller output. 


KPLOTS 

(348) 

Platform drive motor torque. 



Single Axis Platform Control System Printed Output 


Fortran Symbol 


Description 


Units 


VNADIRl 

VNADIR2 

VNADIR3 


Filtered body frame components 
of earth. Nadir pointing unit 
vector. 


AZIH ERR 
AZIM PID 


AZIM MOT 


N.D. 

Gimble platform azimuth error angle . deg. 

Gimble platform azimuth PID output. Depends 

on PID 
gain 

constants 


Gimble platform azimuth motor 
torque . 


ft-lbs 
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3.3 Internal Torque Input and Output 


* 


Fortran Symbol 
IOUTPT (150) 

IOUTPT (1) 


IOUTPT (2) 


IOUTPT (3) 


1*4 

ternal reaction torques for 
reaction controls 

Control word to invoke 
reaction torque output 

IOUTPT (1) 0 No output 

IOUTPT (1) 1 Output 

Location of reaction torques 

For I WHEEL 1 IOUTPT (2) 1 

For IAMPRM( 1)1 I0UTPT(2) 4 

For IAMWH(l) 1 I0UTPT(2) 7 

Location of control motor 
torques 

For lAMPRM(l) 1 I0UTPT(3) 14 
For IAMWH(l) 1 I0UTPT(3) 17 


Preset 

Value Description 

0 Control for output of in- 


Plotting Locations 

for Internal Torcjues 


Input Symbol 

Description 


KPLOTS (358) 

Reaction torque on body 1 

axis ♦ 

KPLOTS (359) 

Reaction torque on body 2 

axis . 

KPLOTS (360) 

Reaction torque on body 3 

axis . 

KPLOTS (361) 

Motor torque on 1 axis. 


KPLOTS (362) 

Motor torque on 2 axis. 


KPLOTS (363) 

Motor torque on 3 axis. 


Internal Torque Printed Output 


Fortran Symbol 

Description 

Units 

TORQUE 1 

Reaction torques acting on 

Ft-Lbs. 

TORQUE 2 
TORQUE 3 

body. 


MT TRQ 1 

Control motor drive torques 

Ft-Lbs . 

MT TRQ 2 
MT TRQ 3 

on reaction wheels. 
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3,4 Autonomous 

Fortran Symbol 
IGMRST 

IGARST (3) 


IGRSCY (3) 
GMDELA (3) 

GMTAUA (4,3) 


GMAN20 (3) 


Scan Capability for Two Axis Scan Platform Input 


1221 


Preset 

Value 


Description 


1*4 


1*4 


1*4 

R*8 


R*8 


R*8 


0 Control word to invoke pre- 
scribed scan motions for v 

two axis gimble. 

IGMRST * 0 No autonomous scan. | 

IGMRST ° 1 Autonomous scan, 

0 Control word to specify type 

of scan cycle to be invoked 
on each axis. 

IGARST(I) b 0 No motion. ! 

IGARST (I) = 1 Motion of type 1. | 

IRARST(l) = 2 Motion of type 2. I 

I - 1 or 3 ] 

1=1 motion about the 3 axis. 1 

I « 3 motion about the 2 axis. 

NOTE: The types of motion 
cycles are shown in reference 2 

0 Number of cycles of scan motion 

to be performed on each axis. 

I 

0.0D0 Angular motion to be per- { 

formed during a single cycle } 

of scan motion for each axis (i 

(deg). j[ 

h 

0.0D0 Time increments to define scan ij 

cycle for each axis See refe- jj 
rence 2. 

r 

GMTAUA (1,1) = T x l 

GMTAUA (2,1) » T 2 i 

GMTAUA (3,1) = T 3 > 

GMTAUA (4,1) = T /+ 

0.0D0 Initial angle for the start t 

of the scan cycle (deg.). i‘ 

?: 
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Output 


There is no special output for rastering of the two axis scan platform other 
than the standard output for the platform motion. 


3 . 5 Field Components and Torques without Attitude Dynamics Input and Output 


Fortran Symbol 


Im. 


Preset 

Value Description 


NOINTG 


NOIOUT (20) 


1*4 0 Control word to bypass inte- 

gration of equations of motion, 

NOINTG 0 Integration carried out. 

NOINIG 1 No integration. 

1*4 0 Control words to invoke printed 

output of external torques. 

NOIOUT ( 1) 0 No gravity gradient 
torques. 

NOIOUT(l) 1 Print gravity 

gradient torques. 

N0I0UT(2) 0 No solar pressure 
torques. 

N0I0UT(2) 1 Print solar pressure 
torques. 

N0I0UT(3) 0 No aerodynamic 

pressure torques. 

N0I0UT(3) 1 Print aerodynamic 
pressure torques. 


NOTE: The control words NOIOUT 
(1), (2), or (3) will control 
printing without regard to 
NOINTG . 
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Plotting Locations for External Torques 


Input Symbol 


Description 


KPLOTS 

(349) 

KPLOTS 

(350) 

KPLOTS 

(351) 

KPLOTS 

(352) 

KPLOTS 

(353) 

KPLOTS 

(354) 

KPLOTS 

(355) 

KPLOTS 

(356) 

KPLOTS 

(357) 


Gravity gradient moment on 1 axis. 
Gravity gradient moment on 2 axis. 
Gravity gradient moment on 3 axis. 

Solar pressure moment on 1 axis. 

Solar pressure moment on 2 axis. 

Solar pressure moment on 3 axis. 

Aerodynamic pressure moment on 1 axis. 
Aerodynamic pressure moment on 2 axis. 
Aerodynamic pressure moment on 3 axis. 


External Torque Printed Output 


Fortran Symbol 

Description 

Units 

GG MOM 1 

Gravity gradient body frame. 

Ft-Lbs 

GG MOM 2 



GG MOM 3 



SP MOM 1 
SP MOM 2 
SP MOM 3 

Solar pressure body frame 
components of torque. 

Ft -Lbs 

AD MOM 1 
AD MOM 2 
AD MOM 3 

Air drag body frame 
components of torque. 

Ft-Lbs 
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3.6 Additional Fluid Damperg Input and Output 


Input 



Preset 

| 

! 

J 

Fortran Symbol 

Im. 

Value 

Description i 

NVDMPR 


1*4 

0 

i 

Control word to simulate 
additional viscous ring 1 

nutation damper. 

NVDMPR a 0 No dampers simulated. 

NVDMPR = 1 One damper simulated, i 

{ 

NVDMPR = 2 Two damper simulated. 

VDVCTY 

(2) 

R*8 

0.0D0 

Kinematic viscosity of liquid 
in nutation damper (centistokes ). 

VDRDTB 

(2) 

R*8 

0. 0D0 

Radius of nutation damper tube 
(inches). 

VDRDRN 

(2) 

R*8 

O.ODO 

Radius of nutation damper ring i 

(inches). \ 

VDDNTY 

(2) 

R*8 

0.0D0 

Density of fluid in nutation | 

damper (lb/ft^). 

VDAXIS 

(3,2) 

R*8 

O.ODO 

Components of unit vector in 
direction of ring axis. 

VrVARY 

(3,2) 

R*8 

O.ODO 

Initial components of torque 
exerted by the liquid upon the 
satellite, directed along the 
damper ring axis (ft/lbs)* j 

VDOMGL 

(2) 

R*8 

O.ODO 

Initial spatial average angular 
velocity of the liquid realtive 
to the ring (deg/sec). 


R*8 


VDJARY (3,2) 


0.0D0 


Fluid Damper Printed Output 


Fortran Symbol 


Description 


Units 


OMEGL 


VSUBL 


MSUBM1 

MSUBM2 

MSUBM3 


Spatial average angular velocity deg/sec 

of the nutation damper fluid re- 
lative to the body (INOPT ■ 1 only) 

Average linear velocity of the ft/sec 

nutation damper fluid relative to 
the damper tube wall (INOPT * 1 only) 

Body frame components of torque ft-lb 

exerted by the nutation damper fluid 
upon the satellite (INOPT * 1 only) 
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